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1.0 INTRODUCTION 


The primary objective of Phase I of this study program (NAS8-23973, "Automatic 
Rendezvous & Docking") was to develop a digital computer program that simulated 
the two earth orbiting satellites while they were performing station keeping and 
docking closure maneuvers. The maneuvers were to be performed automatically 
using the Scanning Laser Radar (SLR) system that was developed on contract NASS- 
20833 to close the loop. Automatic rendezvous and docking capability depends on the 
use of the on-board digital computer to produce steering commands to the autopilot 
generated from the sensed state parameters. For this study, the main sensor is 
the ITT Scanning Laser Radar which provides mutual range, range- rate, angle and 
angle- rate data to the vehicle computer. Since measurement parameters are corrupted 
by noise and the system state (vehicular positions and velocities) is defined by a 
dynamical system, a recursive filter was designed to estimate the vehicle state 
from the noisy measurement vector. 

Section 2. 0 of this report defines the general rendezvous and docking problem studied 
here and section 3. 0 discusses the overall control problem. Section 4. 0 and section 5. 0 
go into the detailed analysis and equation of motions developed for station keeping and 
docking closure respectively. Section 6. 0 and section 7.0 discuss the Kalman filter 
and the combined filtering and control. Appendices A, B, and C are computer plots 
of the results for station keeping, docking closure, and the recursive filter simulations. 
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2. 0 PROBLEM DEFINITION 


Performance of rendezvous and docking requires knowledge of relative positions 
and velocities of the spacecraft involved,, Generally a rendezvous and docking 
mission has a target vehicle in orbit with its orbital parameters known from ground 
tracking,, The chaser vehicle is launched into orbit, and when the relative range 
is short enough (i. e. , <75 miles) for the chaser vehicle on-board sensors (i„ e. , 

Laser Radar) to acquire target vehicle relative position and velocity data, thrusting 
is applied to cause the chaser vehicle to come within close proximity (1000 feet) 
of the target vehicle,, A station keeping mode is used for final checkout prior to 
closure for docking,, 

Considering the Scanning Laser Radar as the primary sensor on the chaser vehicle, 
digital computer programs were developed to simulate the target and chaser vehicle 
motions during certain phases of automatic rendezvous and docking. The two vehicles 
were put into earth orbit with an altitude of 200 nautical miles. Phase I ; reported 
hereymly considers the station keeping and docking closure phases. Station keeping 
is. performed at a range of approximately 1, 000 feet and docking closure is from 
1, 000 feet to 1 foot short of actual docking contact. Filtering of the Scanning Laser 
Radar observations and generation of minimum fuel-minimum end point error thrusting 
programs were developed. The digital computer programs, developed to study 
primarily the laser radar system for automatic docking and rendezvous, accept noisy 
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measurements of range, elevation and azimuth. angles. From this, the dynamic 
filter gives the estimate of state (i 0 e„ , position and velocity of each vehicle), 
assuming the computer has knowledge of the position and velocity of the target 
vehicle at all times. This estimated state is used to generate thrusts in accordance 
with station keeping and closure guidance laws. One closure technique involves 
the maintenance of the chaser within pre-determined range/range-rate criterion 
and line-of- sights LOS) rate limits. An altenate technique, involving frequent 
solution on-board the spacecraft of a minimization equation to obtain the thrust 
program for specific initial conditions with given minimum energy criterion, has 
given us excellent results and is fully explained with results in Section 5. The 
station-keeping criterion is based on thrust-free movements of the chaser under 
two thrusts; one being the maintenance of the target within the view constraints of 
the laser radar, the second being the station-keeping tolerance. Thrusting will 
only occur if either or both constraints are violated. 
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3. 0 OVERALL CONTROL PROBLEM DESCRIPTION 


Figure 3„ 1 is a simplified block diagram of control loop simulation. The Scanning 
Laser Radar System (SLR) with its range and angle measurements corrupted by 
noise feeds into a vehicle guidance and control computer. This computer has two 
sub sections. The recursive filter sub section estimates the State (Position and 
Velocity) of the Chaser vehicle based on observations by the SLR systems. The 
coordinate system chosen for this program is a target centered rotating coordinate 
system. The filter output enters the thrust program and, based upon a typical 
station-keeping and closure guidance law,AVCommands are generated. Through 
the jet select logic, these commands are turned into a sequence of burn times for 
specific jets. This data is sent to the Reaction Control System of the Chaser vehicle. 

Sections 4,5, and 6 discuss the station-keeping, closure control and recursive 
filtering programs generated and make analysis of Simulation results. Detailed 
outputs of the computer are in appendix A, B and C. 

Section 7 discusses the combined filters and control scheme and Figure 3-2 is 
representative of this scheme. 

Section 6 explains inputs to the filter as shown in the Figure 3-2. 


3-1 



RENDEZVOUS S DOCN/NO 


<pArc 

DYNAMICS 


REACT/ON 

CONTROL 

SYSTEM 


^ - // 
-- / / 

/ / 

/ / 

/ / 

/ / 

Z_^ 

/MU 

HOR/Z. SENSORS 
RATE, GYROS 

INTERTIAL 

ATTITUDE 


LASER 

RADAR 


Jl. 


! THRUST PROGRAM | 

I • RENDEZVOUS \ 

I 'STATION- KEEPING f 

I • DOCRING ' 

1 I 


ESTIMATED 

STATE 


VEHICLE COMPUTER 


RECURSIVE ! 
1 F!L TER \ 

I , ! 


I ORBITAL UPDATE \ 

\ PROGRAM 1 
I ; I 


Figure 3-1. Simplified Block Diagram of Control Loop Simulation 












4„ 0 STATION KEEPING 


4„ 1 ANALYSIS AND SIMULATION DETAILS 

We use the x, y, z rotating frame of reference fixed to target for 
analysis of station keeping. The target is assumed at 200 n mile circular orbit. 
The relative equations of motion as shown Section 5 are 

^ _ <0 

^ -V to x y - —• (2.) 

If the applied thrusts are zero, the equations may be solved to yield 
x, y, x, y for given values of x(o), y(o),' k(o) and y(o) and fixed time. 

Using state notations as shown Section 5 the state vector of chaser can be 
written as 

y/+\ _ A4*) r* A(*-T) 

X0*J - e •*.(£) -t- e Jr 

where 
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The objective is to obtain a thrust program for automatic station 
keeping using as a measure of performaneeAV requirement. Equation (4) was 
programmed on the computer which gave the chaser state for any time duration 
for given initial conditions. 

From physics considerations, for minimumAr , the chaser position 
should be in front or behind the target on the same orbit. 

Due to the laser scanning radar field -of -view limitations, proper' 
thrusting was done to maintain the chaser within a +_ 15° cone from the target 
during the station keeping period of 6000 seconds. Analysis and simulation results 
show that the laser radar measurement accuracy is the important parameter to 
minimize aV during station keeping. The L. S.ft. with its range rate accuracy 
(3C value) of + . 016 ft/sec. can reduce significantly station keeping fuel as 
discussed in the next subsection. It is noted that in order to maintain the L.-S.ft. 
element in the chaser within its own +_ 15° field -of -view some fuel will have to 
be expended for rotational control of the chaser vehicle. The extent of this 
addition will be looked into during Phase 2 studies of this contract. 
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4 0 2 


DISCUSSION AND SUMMARY OF RESULTS 


Two positions of chaser vehicle both in front and behind the target vehicle were 
simulated. Charts A-l to A- 6 in appendix cover the results of chaser being 1000 feet 
in front of target on the x axis. 

Results are summarized as follows 

a. Chase* initial state x = 1000 feet 

y = 0 feet 

x = „ 064 Ft/Sec 

o 

y = . 064 Ft/Sec 

A v applied at TR (Running time) 1500 = 2 x .1356 ft/sec 

Av applied at TR 3500 = 2 x . 1229 ft/sec 

A v applied at TR 5300 = 2 x . 1218 ft/sec 

Total A v for 6000 second period = 0.760 ft/sec 

B-2 shows that the chaser vehicle is within + 15° F. O. V. of Target 
Segment $ S. L. R. 

b. Chaser initial state x= 1000 feet 

y= 0 feet 

o 

x = .032 ft/sec 

o 

y = . 032 ft/sec 

Total Av for 6000 second period = . 38 ft/sec 

c. Chaser initial state x = 1000 feet 

y = 0 feet 

o 

x = o 016 ft/sec 

o 

y = , 016 ft/sec 
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Total Av for 6000 second period = „19 ft/sec 
Charts A- 7 to A- 12 appendix show similar results for chaser having an initial 
position of 1000 feet in front of target. Since the S. L„ R„ has an accurate low range 
rate measurement capability, station keeping Av’s can be significantly reduced by 
incorporation of this type S, L, E. Of course for long time station keeping, the savings 
in fuel are more significant. 
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5. 0 CLOSURE CONTROL 


5. 1 ANALYSIS 

x, y, z is rotating frame of reference fixed to target 


w = If a 
v /i 3 


*T «roe 
Vehicle* 


U , CHasev- 

3 ^ / V*V\\tW 

/im $*«*£. 

/T \ Ioirt»4»vl pla^ 

y\ \ 


^ ^y»JS - 'frv Ov*bi*^tvi piin? 

- The angular rate of x, y, z rotating frame. g **i* _ Worin| J 4o +K ^ 

oirb;4A.\ latte- 
s' = gravitational constant at earth surface , , , « 

E # 2 0 rhi+d 

= 32. 17 ft/sec (mean value) and (* CaL | 

v 


= Earth radius = 20. 89 x 10 feet (mean radius of earth) 
= distance to target from earth center 


Assuming target at 200 n. mile circular orbit 

r = 22.1052 x 10 6 feet 

-3 

w = 1.14x10 rad/sec. 
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The differential equations of motion considering only in -plane motion, are 


*• _ * x 

x - 2 w y = 

J m 


O) 


»• • 2 y 

y + 2wx-3\v y = — d ~ 

m 


Here T^, are applied thrusts along x and y. 


CO 


If the applied thrust is zero, the right sides of (1) and (2) are zero 

and the equations may be solved to yield expressions for the relative rate and 

• * 

distance subject to initial values of rate x , y and distances x , y . When this 
J o J o o 

is done the rate and position at some later time is 

X = (4 * 0 - w ) + 2- ^ 0 A*y\ ± 

^ _ *+■ C^ 0 C&l ufj^ 
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The objective is to obtain a thrust program for automatic closure using as a 
measure of performance AV requirements and closure end point errors . 
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This is equivalent to minimization of the absolute value of the components of 
u (t). 


A mathematically convenient performance measure can be the following. 

We seek to find the u(t) which will minimize 

C t[ U.C*) \\ * It + llx-tTllf" (5) 

^ o 

5 . 2 THE EPSILON TECHNIQUE 

Instead of minimizing Equation (5), we use a so-called epsilon technique to solve 
the optimal control problem. That is, for each^^C^ we seek a u(f, t) such that 

j s T ^ 

= 2 6- J c li *(t )- A X^)-®w(£)|| dJf (6 ) 

+ J. II u<*>jf A* + 1| x(r)|| l 

is minimized. ' 

The optimal u(£ , t) must satisfy 

Agfc)- * o 

I 

or equivalently, 

CL. (<i*s+z.*l)''fS*Y 

where Y - X(*) - A *(*) 

where * denotes the transpose. 


5-5 



With the relation of (7), we want to minimize Equation (6). Substituting u of 
(7) to (6), we get 

_ i 


2* 


This is because 


{{h W- gm s£j]<be 

+ llxCr)ll** 

f J* y 

J fc ’ zi J e || x - A 6t LWl/% £l| 5X»)||V 

-> U 

Z-fc J", £ll*- Axll^- 2.^ 8*^ 

notice that + £-1 jeUt t llxtrjU 2 ' 

[s£,&^ + Z£LC.,Cl]= [(a*64i&)u y ixr| 

= LC&*S-i-Zfc).ei, (S*&4Zfc)'V<*-A*)] 

» c*. , = c *-**•, aC 3 

=r> Tfe - "^T II *~Axl| 7 '- £*.- A*. %}<3 + II yCrJjl^ 

so our problem is as follows. With 

CC ss ts^&+ztX/'6*a-Ax) 

find x (£,t) such that (8) is minimized. 


Notice that x ("t-* O 

^ C r)»^ T X.*J - * M S^jds 
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So V* 3e - ^e~{£ T [-2 A ^-A>c) + ZA ¥ 6(6%42fI)V(X-A^<tt 

- 2 A" 1 0s*<2> + zeX)' 1 ds 
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Notice that this is true for each £ > O 


(■k-A^c) 4- G>£6*t!>4X*l)''s*(X'Ax.) 
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Eliminating x q from (12) and (u))we obtain 

m -A m - (Mf &(&** + 2*xf 

. (?(*) - < 9 (T))"' e A ^' 

Hence finally we get | 
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This is the synthesis form,u(t), and x(t) depend on € t Aiso in Equation (13) 

as £ — ^ O 
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and u(t) converges to 
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This is the optimal solution for our system. Since B = I in our case ? (l 4) 


*1 




so we have the solution for minimizing total energy and end position. We are 
not minimizing fuel^T which is equivalent to min. J** j a Co/di . This is 
because of the difficulty in mathematics to handle absolute value. But we expect 


the optimal solution of min 


here. 


•J" wi 


ill be very close to what we have go? 


5.3 Implementation 

We now consider computer simulation of the closure problem. The procedure 
is as follows: 

We estimate x(o) and compute u(o) by 

-A*rr c T ACf-s) a^Ct-s) 1 at 

= e j_\ e e . MsJ «■ ) 

AX 

Because w = 0.00114, a very small number is almost linear within a 

period of 1 second. 

So the integration can be approximated by trapozoidal rule with step size ol 
1 second. We also can maintain u to be constant within the period of 1 second. 
So we have 


>*(*) 

~ -u.t©} 

0 £ 
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l £ 
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T-l 


Wt cA ( T ACt-s) A%-s)j -T “ i A(t-kj 

"<*) = *- T e. djJ e x (k 4 

a«J *(_*.) s e A '' 4-[^ e A(lC '^ r ] U <K-0 

Fov K = O j i ( Z ) .., j T, 



An APL program is written for this optimal control problem. Several runs have 
been made on IBM 360/50 computer with different starting positions and closure 
times. The results are shown in Appendix B. 

In the next section, we analyze the excellent results we have obtained. 
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5.4 


EVALUATION AND SUMMARY OF RESULTS 


Closure control simulations were performed for closure times (d^ of 900 
seconds, 300 seconds and 150 seconds. 

u 

1. For the 900 second closure time, the chased state at time 0 was 
x = 500 feet 


y = - 500 feet 

x = - . 6 ft/ sec 

y = . 6 ft/sec 

The first eight charts (Appendix B-l to B-8) are the results for this 
case. 

Final value 


x = .000376 feet 

x = - .000623 ft/sec 

y - - .000289 feet 

y = .00374 ft/sec 


&V ^ i.q 

B-l shows x vs TR where TR stands for running time 

B-2 shows y vs TR 

B-3 shows y vs x 

B-4 shows x vs TR 

B-5 shows y vs TR 

Tx 

B-6 shows ~=rr- vs TR 
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B-7 shows 


vs TR 


ST 

m 

B-8 shows DELV (ft/sec) for the closure operation 

Some comments are in order. Of all the runs this run is perhaps 
the best and indicative of the effectiveness of the optimal control 
program. As B-l (x vs TR) and B-2 (y vs TR) indicate the last 
hundred seconds, the approach trajectory is a very desirable one. 

Also as B-3 indicates, the approach is almost within the +15° cone 
from the target. Perhaps one or two rotational adjustments by the 
chaser may only be necessary. Further as evident from our Kalman 
filter Simulations results, the combined filter and sub optimal con- 
trol program will degrade the end point error to the extent of the 
3<T values of the range and range rate accuracy of the Scanning Laser 
Radar. Additional simulation results in this area will come as part 
of Phase 2 studies. 

As B-8 shows, we achieve a Av in the area of 2 ft/sec for this 15 
minute optimal control run. 

2, For the 300 second 'Closure time, two starting points were considered. 
Curves B-9 to B-24 in the Appendix tell all the story. However, the 
following data is a summary. 
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a, 


x 


-500 feet 


y = -600 feet 

• 

x = - .032 ft/sec 

y = - 1.2 ft/sec 

Final value 

x = 
x = 

y - 
y = 

A v 1 4- 

b. x = 1000 feet 

y = —1000 feet 
x = - .6 ft/sec 

y = . 6 ft/ sec 

Final value 

x - 
x = 

y = 
y = 


av —18.7 


- .0067 feet 
0. 0434 ft/ sec 

- . 0084 feet 
.0381 ft/sec 


.0088 feet 

- .046 ft/sec 

- .010 feet 
.0738 ft/sec 
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3. For the 150 second closure time, 14 starting points were considered. 

Curves B-25 to B-136 contain a wealth of data. The. following summary 
is in order 

a. x = 500 feet 

y = 0 feet 

x = 0. 6 ft/sec 

y = - .032 ft/sec 

Final value 

x = .0213 feet 

y = - .133 ft/sec 

x = - .0009 feet 

y = .0162 ft/sec 

A v <=12. 

b. x = 500 feet 

y = 500. feet 
x = .6 ft/sec 

9 

y - - . 6 ft/ sec 

Final value 

x = . 0218 feet 
y = - .1467 ft/sec 

x = .0173 feet 

y = -. 1032 ft/ sec 

tv ~ <L 0 
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c. x = -500 feet 

y = 0 feet 

* 

x = 1.2 ft/sec 
y = 1. 2 ft/sec 

Final value 

x - - . 0156 feet 

y = .1086 ft/see 

x = . 0036 feet 

y = - . 0267 ft/sec 

iy = 10 

d. x = -500 feet 

y = -500 feet 
♦ 

x = - .6 ft/see 

y = - .6 ft/see 

Final value 

x = - .0223 feet 

x = .1493 ft/sec 

y = - .0209 feet 

• 

y = .1179 ft/sec 

AV 


5-15 



e. x = -500 feet 

y = H-500 feet 

x = .6 ft/sec 

y = - .6 ft/sec 

Final value 

X = - . 0174 feet 

* 

x = .1053 ft/sec 

y = .0184 feet 

y = - .1322 ft/see 

av ~ 

f. x = 500 feet 

y = -500 feet 

x = -. 6 ft/ sec 

* 

y - . 6 ft/ sec 

Final value 

x = . 0174 feet 

x = - .0153 ft/sec 

y = - . 0184 feet 

y = . 1322 ft/sec 

av -ie .,7 
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g. 


X 


0. feet 


y = -1000 feet 

x = 0 ffc/sec 

y = 0 ft/sec 

Final value 

x = .0014 feet 

x = - .0291 ft/see 

y = .0398 feet 

• 

y = - .2528 ft/see 

hV si *12. 

h. x — -1000 feet 
y = 1000 feet 
x = 1.2 ft/sec 
y = -1.2 ft/sec 

Final value 

x = - .0349 feet 

• 

x = .2107 ft/sec 

y = . 0369 feet 

* 

y = - .2645 ft/see 

tv 
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X 


-1000 feet 


y = -1000 feet 

x = . 032 ffc/sec 

y = - 1. 2 ft/sec 

Final value 

x = - . 0410 feet 

x = .2834 ft/sec 

y = - . 0423 feet 

• 

y = .2386 ft/sec 

Av - 4Z 

x = -1000 feet 

y = 0 feet 
* 

x = 0 ft/sec 

« 

y = . 032 ft/sec 

Final value 

x = - . 0392 feet 

x- = .2520 ft/sec 

y = .0012 feet 

y = - .0294 ft/sec 

- 7 . 1 , 
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k. x = 1000 feet 
7 ~ -1000 feet 
• x = -.6 ft/sec 
y = +.6 ft/ sec 

Final value x = .0364 ft. 

x - -.2168 ft/sec 
y = -.0389 ft. 
y = .2732 ft/sec 

A V = -Jg 

1000 feet 
1000 feet 
-.6 ft/sec 
-.6 ft/sec 

Final value x = .038 ft 

x = -.2725 ft/sec . 
y = .0372 ft. 
y = -.2177 ft. sec 

AV ~3 8 
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6 <> 0 KALMAN FILTER 


6 0 1 ANALYSIS AND SIMULATION DETAILS 


The laser scanning radar measures range, azimuth and elevation angles between 


the chaser and the target. In terms of the coordinates chosen in Section 5. 0 they 

2 2 2 — ~1 -X 3 -1 X 5 

are ( x. + x„ + x_ ) 2 , tan and sin 

1 <3 5 -x 


2 2 2 \- 
X 1 + X, + x K 2 


respectively. We recall that the coordinate system was target centered with the 

y or x 3 direction along the target local vertical, the x g or z direction is aligned 

with the orbit normal and the x or x^ direction'! s in the orbit plane. Since we 

assume both chaser and target are on the same plane the laser scanning radar 

measures only range and azimuth angles. For analysis purposes the nonlinear 

measurement (in terms of x^ and x g ) is rather cumbersome. Hence assume for 

each measurement, we can make a transformation to obtain the observation values 

of x and x . Then we have the following observation equation 
X o 


2. ,(*) 


n \ 000 



4 - 

' M, ( A ) 



00 \ 0 


*5 
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Our system model is then 


x(t) = A x(t) 

(1) 

z(t) = C x(t) + N(t) 

(2) 


where A is specified in Section 5 and 



The above noise convariance matrix is obtained using the value of 
10 cnfs as the three sigma position, accuracy of laser scanning radar. Of course, 
once the transformation box referred to previously has been built, the convariance 
matrix of the noise N vector is obtained from experiments. 
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The laser, statistics for the Kalman recursive filter is as follows 


Range 0 - 120 km (75 miles) 

Range accuracy (3fl“ ) +_ 0. 02% or + 10 cm 

(whichever is greater) 

Range rate 0-5 km/sec. (11,200 mph) 

Range rate accuracy +1. 0% or +_0. 5 cro/sec. 

(whichever is greater) 

2 

<T here denotes the standard deviation and C is the variance. 


The well-known Kalman-BuCy filter is utilized in the estimation of 
chaser position and velocities (i.e. , coordinates x , x 2> and x^) from noisy 
measurements azimuth and range by the laser scanning radar. The equations 
are 

£ = A x (t) + K (t) jz (t) - c x (t)j 
K(t) = P (t) C T R _1 (t) 

P(t) = A P (t) + P (t) A T - K (t) C P (t) 


with x(o) known, which is a small variation of the true value x(0). 

For Kalman filter mechanization we choose the following 

P(o) - Pq 



.Oil. 

o 

o 

o 

— 

o 

.011 *.)0 

o 

o 


o 

o 

. oil 

o 

i 

o 

o 

o 

.01Z 
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Since observation is discrete, we can select the observation period T to be the 
integration step time in the Kalman recursive filter, which is taken as 0, 1 sec. 
Our Algorithm for Kalman filter is then 
X. Calculate R \ where R = E N T (Kr 






S 3 . 61 zn 


2.. Calculate 


z(o) = C x(o) + N(o) 

K(o) - P(o) C 1 R~‘ 

X(°)~ Axfe)4- K(o)Q^fe) - Cx^jl 

Pfe) - AP&>) +- Pc») A T - K(o)c P( 0 ) 


3. Calculate 

# 

xfr) - £.(o) + x(o) +L*tI 

AT « T a. O. I Stcnds 

PCr) - Po>) f (o) {_ at^ 
k (r) - 9 fr ) c T gr' 
fcCr) - A $.6-) +- k6-)5\kt) - 

p(r) - A P6-) -e p Ct) a t - K6") c P6-) 
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We proceed for t = 2T , , . . . KT* where K*T = T, the final time for 

observation.. 

The simulation results are given in Appendix C. Discussions of the 
results follow. 

2 DISCUSSION OF FILTER SIMULATION RESULTS 
Charts C-l to C-10 in the appendix show the effectiveness of the filter for various 
initial conditions of the Chaser vehicle . 
a. Estimated State at time o 

A 

x^= 1000. 4 feet 

A 

x 9 = -1, 02 ft/sec 

A 

x = 1000. 4 feet 

A 

x = -1. 02 feet 

True state at time”0 n which was fed into the laser error model 
x^ = 1000 feet 
x 2 = -1 ft/sec 
Xg = 1000 feet 
x 4 = -1 ft/sec 

Curve C 2 and shows the convergence of x and y to the true x and y 

a . 

in about 5 observations. Curves C 4 and C & show plots of x and y in relation 

o o 

to true values of x and y . The convergence is slower than the range 

o o 

convergence since x and y are not observed variables. 
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b. Estimated State at time ,f 0 " 

A 

x^ = 500,4 feet 

A 

x = +1,02 feet/sec 

A 

x — 500,4 feet 

O 

x = +1. 02 feet/see 

True state at time "0" which was fed into the laser error model 
x^ — 500 feet 
x = 1 feet/sec 

A 

x = 500 feet 

O 

x^ = 1 feet/sec 

Curves C-6 to C-10 show similar results as case "a". In this case 
more observations are needed since initial estimate is further apart 
from true values than in the case "a". 
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7.0 


COMBINED FILTERING AND CONTROL 


7. 1 ANALYSIS 

The optimal control as carried out in section 5 is a continous thrust control which was 
used to obtain theoretical limit valves of AV for various closure times. When we 
use constant magnitude thrusters, we design a sub optimal control in the following 
manner. The change we make is to fix the amplitude of thrusts according to the 
design valve and to vary the thrust time length. 


A# a 

Let U. be the constant thrust force. From section 5, we know the optimal u(jf ), 
k £ t i k+1 , is i 

... A*tT-K)r f T A(t-s) A *(T-s) ( ~"f A(t-k) . 

M-&) =■ - e. |_Jk c e asj e. 

which is a 4 x 1 vector. Let 

r j*. <*n 

^ 

L ^*4 &") J 

The sub optimal design involves the selection of the following: 

A (k) - 

\A» 

•<w 

\u.^l 


•^3 CK) — 
- 


wU vc-r 


Then our original and new thrust periods are: 



k = 1,2, 3, 4 
k =0,1,2..,., T-l 




k = 1, 2,3,4 
k = 0, 1, 2, T-l 


Sub optimal thrust in coordinate 




It should he noted that (^) and u^ (Jf) correspond to impulses of velocity in 

X and X directions, where as u (*) and u (Jt) correspond to Tx and 
i « A o 1 

m 

2 

TXg which have units of acceleration (Ft/sec )„ Since the optimal control 

m 

program, calls for thrust input to be constant for one second, acceleration integrated 

over one second gives us velocity change. Simulation results show for o j ium pe time 

of 900 seconds, the u (*) and u (*) values are- negligible compared to u r , (■*) 

X o 2 

andu^ (X). 


The sub optimal program is being tested. 
Phase 2. 


The .results will be included in the 


7,2, Implementation 


The following steps explain how sub optimal control program and Kalman filtering 
program are combined. 

1. At t = 0, we calculate the optimal control u (0). Using this and IT we cal- 

culate t^ (0), k = 1,2, 3, 4. 
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r a, c*r 

~ . *a«M 


- O 


0 6±6 X ^.,\i 

0^ 4 ^ *£***, 

f-* £ f 1^4 i±£ , 

I- *> ^ _fl- * l+*» 

~i~ — — ^T“ 

1 - 4. -f £ l 4-Jfefc . 

a. - 5T - 

lr*i * 6 l+*3 

Mg* l A > CHI 

1 \ — 1 i-f ii i n n /in»r>+i vtrt 


. V 3.T,*gt * ^ S> I » *4. 

where sign (u^) =+l if u^ is positive and sign* (u^) = -1 if u^ is negative.^ 

When thrust is ended, Kalman filter is on titles! second,. Based on estimated 
value rf X_ (1), we do 1,2 for 1 £]&£ 2 again. 

T-l 

Do 1,2,3 for k£t£ k+1 until k=^H seconds. An important remark 
should be made, that in this type of sub optimal combined filter and 

thrust control program, foijfc=k, we treat the problem as if it were 

»• 

stated at t =. k seconds so* that the accumulated error won’t propagate 
^ie^ in other words we determine the control u, based on latest information) . 
Errors such as thrust end point etc. , can conveniently be compensated by 
this technique. 


The complete combined program will come out in the Phase 2 report. 
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APPENDIX A 


RESULTS OE STATION KEEPING SIMULATIONS 


A-l 



Chaser State at TR = 1500 


1062.249335 
"0.10075933 
“72.26286404 
"0. 1356421212 


SKI 

INPUT X : 

D: X X / y 

1000 .064 0 .064 

[ Chaser behind Target ] 


Chaser State at TR = 3500 


1. .13192773253 
4. 554625260£ , ~2 
4 . 8046602 Q2E1 
1.2295456462?"l 


Chaser State at TR = 1500 
after Av in the y direction 

1062 . 249335 
0.10075933 

“72.26286404 

0.1356421212 


Chaser State at TR = 3500 
after A v in the y direction 

1 . 1 31 9 2 7 73 2273 
“4. 5546252 6 02?" 2 
"4 . 8 046602 0 25T 
1.2295456462?"! 


Chaser State at TR = 6000 


1 . 24020015 5273 
8.72961 20562?“2 
1 . 02175967 3271 
3.12796940 62? 2 


A v for Period 6000 Seconds (Ft/sec) 
0.7608337824 


AH 


^TATioN 


Chaser State at TR = 5300 


.1. 215757153£3 
4.1802296142?~2 
640451585F1 
1 . 218202054F"! 


Chaser State at TR = 5300 
after A v in the y direction 

2 1575715 3273 
~4. 18022961 427" 2 
"4. 64045 1585F1 
1. 21820205 42?~1 




0 Position OF^ ... 

Q Poir rtorti o^ <tHASit<? 

» . • t 


l 





Station ke.e*mn& behind target 

CWAVER ATTINEO HA$ * * 

y st ^ rT 

.To-tAu A V Pofi 1^00© SfcC. 5.761 P*r/**X . 

A -' 2 L, 



Chaser State at TR = 1500 

SKI 

INPUT X : 

□: x x y y 

1000 .032 0 . 032 . 
[ Chaser behind Target ] 
Chaser State at TR = 3500 

Chaser State at TR = 5300 

1 . 031124668273 

1 . 06596386 6273 

1. 107878576 27 3 

”5.03796650 127” 2 

”2.27731263027 2 

_2.090114807Z7 - 2 

"3. 613143202271 

”2.402330101 271 

“2. 32 022 57 92271 

6.78210605827 2 

6.14772823227 2 

~6 . 09101026927 2 


Chaser State at TR = 1500 
after Av in the y direction 


1. 03112466 8273 

5, 03796650127~2 
3. 6131432 02271 

6. 7821060 5 8Z7 - 2 


Chaser State at TR = 3500 
after A v in the y direction 


1. 065 9638'6 6273 
2.2773126 30 £’"*2 
2. 402330101271 
6. 1477282 3 227~2 


Chaser State at TR = 5300 
after A v in the y direction 


1.107878576^3 
2.09011480727~2 
2. 3202257 92 271 
6.0910102 6 927” 2 


Chaser 

1 . 

4. 

5. 

1 . 


State at TR = 6000 


12010007 7273 
36480602 827 2 
108798367270 
56398470327“2 


Av for Period 6000 Seconds (Ft/sec) 
0.3804168912 


A -3 



MD. 14nA - ] □ 
1 


DtETZ GE N GRA PH pAPFR 

HK peiHHh IB8S 


EUGENE DlETZG EN CO. 

A 



ITT 


A-4 


















Chaser State at TR = 1500 


1 . 01556233453 
2, 5189832505~2 
1.80657160151 
3 . 39105 302 95"2 


Chaser State at TR = 1500 
after Av in the y direction 


1 . 015 5 6 23 3453 
2. 51893325 05" 2 
1.8 06571 6012?! 
3.39105302 95~2 


SKI 

INPUT X: 

□ : * 

1000 


* y y 

016 0 .016 


[ Chaser behind Target ] 


Chaser State at TR = 3500 


1 . 03298193353 
"1.1386563155 2 
1 .20116505051 
"3. 0738641 165~2 


Chaser State at TR = 3500 
after A v in the y direction 

1 . 03298193353 
“1 . 1386563155 2 
“1 .20116505051 
3 . 07 38 641 1 65’~2 


Chaser State at TR = 6000 


1 .06005003953 
2 . 1824030145~2 
2 . 55439918450 
7 . 8199235 1 65~3 


Chaser State at TR = 5300 

_1. 05393928853 
_1. 0450574035~2 
1 .16011289651 
~3. 0455051345~2 


Chaser State at TR = 5300 
after A v in the y direction 

1.05393928853 
~1 . 045 0574035~2 
"1.16011289651 
3. 0455051345~2 


A v for Period 6000 Seconds (Ft/sec) 

0.1902084456 
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SKI 

INPUT X : 

0: X x y y 

“1000 .064 0 .064 
[ Chaser in front of Target ] 


Chaser State at TR = 1500 

Chaser State at TR = 3500 

Chaser State at TR = 5300 

"937.7506646 

0.10075933 

“72.26286404 

“0.1356421212 

“868.0722684 
“0.0455462526 
“48 . 04660202 
"0.1229545646 

"784 . 2428473 
“0. 04180229614 
”46 . 40451585 
0. 1218202054 

Chaser State at TR = 1500 
after Av in the y direction 

Chaser State at TR = 3500 
after A v in the y direction 

Chaser State at TR = 5300 
after A v in the y direction 

“937.7506646 

“0.10075933 

"72.26286404 

0.1356421212 

”868.0722684 

"0.0455462526 

"48.04660202 

0.1229545646 

”784.2428473 
“0. 04180229614 
”46 . 40451585 
”0.1218202054 


Chaser State at TR = 6000 

"759.799845 

0.08729612056 

10.21759673 

0.03127969406 

- 


A v for Period 6000 Seconds (Ft/sec) 
0. 7608337824 
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SKI 

INPUT X : 

□: x x y y 

"1000 .032 0 .032 
[ Chaser in front of Target ] 


Chaser State at TR = 1500 


968 .875332 3 
0. 05037966501 
"36 .13143202 
0.06782106058 


Chaser State at TR = 3500 


934 . 0361342 
"0,0227731263 
"24.02330101 
"0.06147728232 


' Chaser State at TR = 5300 

"892. 1214237 

0. 02090114807 
"23. 20225792 
0. 06091010269 


Chaser State at TR-= 1500 


after 

Av in the y direction 

"968 

. 87533 

23 

"o 

.05037 

966501 

"36 

. 13143 

202 

0 

. 06782 

106058 


Chaser State at TR = 3500 
after A v in the y direction 

"934.0361342 

0.0227731263 

"24.02330101 

0.06147728232 


Chaser State at TR = 5300 
after A v in the y direction 

"892 . 1214237 

0.02090114807 
"23.20225792 
0. 06091010269 


Chaser State at TR = 6000 


879.8999225 
0. 04364806028 
5 .108798367 
0. 01563984703 


A v for Period 6000 Seconds (Ft/sec) 


0.3804168912 













SKI 

INPUT X: 

□ : x x y y 

“1000 .016 0 .016 

[ Chaser in front of Target ] 


Chaser State at TR = 1500 

Chaser State at TR = 3500 

Chaser State at TR = 5300 

984.4376662 

0.0251898325 

18.06571601 

“6.03391053029 

"967 . 0180671 

“0.01138656315 

“12.0116505 

"0.03073864116 

“946.0607118 
“0.01045057403 
11.60112896 
“0. 03045505134 

Chaser State at TR = 1500 

Chaser State at TR = 3500 

Chaser State at TR = 5300 

after Av in the y direction 

after A v in the y direction 

after A v in the y direction 

984 .4376662 
“0.0251898325 
“18 . 06571601 
0. 03391053029 

"967.0180671 

"0.01138656315 

"12.0116505 

0.03073864116 

“946. 0607118 
“0. 01045057403 
“11. 60112896 



0. 03045505134 


Chaser State at TR = 6000 


9. 39949961 32? 2 
2 . 1824030142 - 2 
2 . 55439918420 
7 . 8199235162 3 


A v for Period 6000 Seconds (Ft/sec) 
0. 1902084456 




A-hL 


I*TT 



















APPENDIX B 


RESULTS OF CLOSURE CONTROL SIMULATIONS 
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CT = 900 Sec. 

x = 500 ft. 

y = -500 ft. 

x = -.6 ft/sec. 

y = . 6 ft/sec. 
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